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PROVISIONALLY DETERMINE GAIT PARAMETER OF CURRENT TIME GAIT 
INCLUDING DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT 
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COMPONENT AT END OF CURRENT TIME GAIT AGREES WITH INITIAL 
DIVERGENCE COMPONENT OF NORMAL TURNING GAIT.) 
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FIG.M 



ENTRY 



S200-1 



DETERMINE FIRST MODEL NORMAL TURNING GAIT THAT SATISFIES BOUNDARY CONDITION ON THE BASIS OF 
NORMAL TURNING GAIT PARAMETER BY USING FIRST MODEL AND DETERMINE FIRST MODEL INITIAL (AT Ts) 
BODY HORIZONTAL POSITION, VELOCITY, ANGULAR VELOCITY, AND BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PEAK VALUES (Xsl, Vxsl, gjbsl, ZMPrecpeakl ). 



S200-2 



USING SECOND MODEL, TAKE (Xsl, Vxsl, cobsl, ZMPrecpeakl) AS SEARCH INITIAL VALUES, AND SEARCH FOR 
SECOND MODEL NORMAL TURNING GAIT THAT SATISFIES BOUNDARY CONDITION ON THE BASIS OF THE SEARCH 
INITIAL VALUES AND OTHER NORMAL TURNING GAIT PARAMETER, AND DETERMINE SECOND MODEL INITIAL 
(AT Ts) BODY HORIZONTAL POSITION, VELOCITY, ANGULAR VELOCITY, AND BODY INCLINATION RESTORING 
MOMENT ZMP-CONVERTED VALUE PEAK VALUES (Xs2, Vxs2, ajbs2, ZMPrecpeak2). 



S200-n 



USING n-TH MODEL, TAKE (Xsm, Vxsm, cubsm, ZMPrecpeakm)(WHERE m=n-l) AS SEARCH INITIAL VALUES, 
AND SEARCH FOR n-TH MODEL NORMAL TURNING GAIT THAT SATISFIES BOUNDARY CONDITION ON THE BASIS 
OF THE SEARCH INITIAL VALUES AND OTHER NORMAL TURNING GAIT PARAMETER, AND DETERMINE n-TH 
MODEL INITIAL (AT Ts) BODY HORIZONTAL POSITION, VELOCITY, ANGULAR VELOCITY, AND BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUES (Xsn, Vxsn, ajbsn, ZMPrecpeakn) 



S204 



BASED ON n-TH MODEL NORMAL TURNING GAIT, DETERMINE n-TH MODEL INITIAL BODY POSITION, VELOCITY, 
POSTURE ANGLE, ANGULAR VELOCITIES (XOn, VxOn, d bOn, cubOn), AND INITIAL BODY VERTICAL 
POSITION/VELOCITY (ZOn,VzOn) AT ORIGINAL INITIAL TIME 0. 



DETERMINE n-TH MODEL NORMAL TURNING INITIAL DIVERGENCE COMPONENT q[0] 
BY USING THE FOLLOWING EXPRESSION: 
q[0] = XOn + VxOn/c J 0 
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S224 



DETERMINE q", WHICH DENOTES VALUE OF n-TH MODEL NORMAL TURNING INITIAL DIVERGENCE 
COMPONENT q[0] OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM OF CURRENT TIME'S GAIT, 
AND DETERMINE (ZO",VzO"), WHICH DENOTE VALUES OF n-TH MODEL INITIAL BODY VERTICAL 
POSITION/VELOCITY OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM OF CURRENT TIME'S GAIT. 
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ENTRY 



DETERMINE INITIAL STATES (STATES AT INITIAL TIME Ts) OF FOOT POSITION/POSTURE, 
BODY POSTURE ANGLE e bs, AND ARM POSTURE ON THE BASIS OF NORMAL TURNING GAIT PARAMETER 



PROVISIONALLY DETERMINE FIRST MODEL INITIAL (AT Ts) BODY HORIZONTAL POSITION, VELOCITY, 
ANGULAR VELOCITY, AND BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PEAK 
VALUE CANDIDATES (Xsl, Vxsl, gjbsl, ZMPrecpeakl). 
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DETERMINE FIRST MODEL INITIAL BODY VERTICAL POSITION/VELOCITY (Zsl, Vzsl ). 



S254 



S256 



USING FIRST DYNAMIC MODEL, GENERATE FIRST MODEL GAIT ON THE BASIS OF NORMAL 
TURNING GAIT PARAMETER INCLUDING ZMPrecpeakl, TAKING 6 bsl,(Xsl, Vxsl, cubsl), 
(Zsl,Vzsl) AS INITIAL STATES OF BODY. 
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S260 



CONVERT BODY HORIZONTAL POSITION, VELOCITY, POSTURE ANGLE, AND ANGULAR VELOCITY AT 
TERMINATING END OF GENERATED GAIT INTO VALUES OBSERVED FROM SUPPORTING LEG COORDINATE 
SYSTEM OF NEXT STEP, AND DENOTE THE CONVERTED VALUES AS (Xel,Vxel, ebel, ajbel). 



BOUNDARY CONDITION ERRORS (errx, errv, err e , err a,) 
= (Xsl, Vxsl, ebsl, wbslMXel.Vxel, ebel, wbel) 
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S264 yes 



ARE ALL errx, errv, err 6, AND 
errw WITHIN PERMISSIBLE RANGES? 



I 



( LEAVE REPETITION LOOP. ) 



DETERMINE A PLURALITY OF CANDIDATES (XsI+aXs, Vxsl, wbsl, ZMPrecpeakl), 
(Xsl, Vxsl + aVxs, wbsl, ZMPrecpeakl), (Xsl, Vxsl, wbsl+ a cobs, ZMPrecpeakl), 
(Xsl, Vxsl, wbsl, ZMPrecpeakl + A ZMPrecpeak) IN THE VICINITY OF 
(Xsl, Vxsl, wbsl, ZMPrecpeakl), AND BASED ON THEM, DETERMINE BOUNDARY CONDITION 
ERROR CORRESPONDING TO EACH OF THEM AS DESCRIBED ABOVE. 



S266 



DETERMINE NEW CANDIDATES (Xsl, Vxsl, wbsl, ZMPrecpeakl ) ON THE BASIS OF BOUNDARY 
CONDITION ERRORS CORRESPONDING TO (Xsl, Vxsl, wbsl, ZMPrecpeakl ) AND EACH OF 
CANDIDATES IN THE VICINITY THEREOF. 
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DETERMINE INITIAL STATES (STATES AT INITIAL TIME Ts) OF FOOT POSITION/POSTURE, 

BODY POSTURE ANGLE e bs, AND ARM POSTURE ON THE BASIS OF NORMAL TURNING GAIT PARAMETER. 



SUBSTITUTE (Xsm, Vxsm, cubsm, ZMPrecpeakmMWHERE m=n-l ) INTO n-TH MODEL INITIAL (AT Ts) BODY 
HORIZONTAL POSITION, VELOCITY, ANGULAR VELOCITY, AND BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PEAK VALUE CANDIDATES (Xsn, Vxsn, ajbsn, ZMPrecpeakn). 
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SI 202 



S1204 



DETERMINE n-TH MODEL INITIAL BODY VERTICAL POSITION/VELOCITY (Zsn, Vzsn). 



S1206 



USING n-TH DYNAMIC MODEL, GENERATE n-TH MODEL GAIT ON THE BASIS OF NORMAL 
TURNING GAIT PARAMETER INCLUDING ZMPrecpeakn, TAKING e bsn,(Xsn, Vxsn, ubsn), 
(Zsn,Vzsn) AS INITIAL STATES OF BODY. 
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S1210 



CONVERT BODY HORIZONTAL POSITION, VELOCITY, POSTURE ANGLE, AND ANGULAR VELOCITY AT 
TERMINATING END OF GENERATED GAIT INTO VALUES OBSERVED FROM SUPPORTING LEG COORDINATE 
SYSTEM OF NEXT STEP, AND DENOTE THE CONVERTED VALUES AS (Xen, Vxen, 9 ben, coben). 



BOUNDARY CONDITION ERRORS (errx, errv, err e , err a; ) 
= (Xsn, Vxsn, e bsn, cubsn)-(Xen, Vxen, e ben, wben) 
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S1214 yes 



ARE ALL errx, errv, err e , AND erraj 
WITHIN PERMISSIBLE RANGES? 
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( LEAVE REPETITION LOOP. ) 



DETERMINE A PLURALITY OF CANDIDATES (Xsn+AXs, Vxsn, wbsn, ZMPrecpeakn), 
(Xsn, Vxsn+ aVxs, wbsn, ZMPrecpeakn), (Xsn, Vxsn, wbsn+ a cobs, ZMPrecpeakn), 
(Xsn, Vxsn, wbsn, ZMPrecpeakn+ a ZMPrecpeak) IN THE VICINITY OF 
(Xsn, Vxsn, wbsn, ZMPrecpeakn), AND BASED ON THEM, DETERMINE BOUNDARY CONDITION 
ERROR CORRESPONDING EACH OF THEM AS DESCRIBED ABOVE. 



S1216 



DETERMINE NEW CANDIDATES (Xsn, Vxsn, wbsn, ZMPrecpeakn) ON THE BASIS OF BOUNDARY 
CONDITION ERRORS CORRESPONDING TO (Xsn, Vxsn, cubsn, ZMPrecpeakn) AND EACH OF 
CANDIDATES IN THE VICINITY THEREOF. 
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ENTRY 



DETERMINE FOOT TRAJECTORY PARAMETER 
OF CURRENT TIME GAIT. 
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S600 



DETERMINE REFERENCE BODY POSTURE TRAJECTORY 
PARAMETER OF CURRENT TIME GAIT. 



S602 



DETERMINE ARM POSTURE TRAJECTORY PARAMETER 
OF CURRENT TIME GAIT. 



S604 



DETERMINE FLOOR REACTION FORCE VERTICAL COMPONENT 
TRAJECTORY PARAMETER OF CURRENT TIME GAIT. 



DETERMINE FLOOR REACTION FORCE HORIZONTAL 
COMPONENT PERMISSIBLE RANGE [Fxmin, Fxmax] 
OF CURRENT TIME GAIT. 
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PROVISIONALLY DETERMINE ZMP TRAJECTORY PARAMETER 
OF CURRENT TIME GAIT. 



SET BODY INCLINATION ANGLE RESTORING PERIOD [Ta, Tb] 
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FIG.21 



S028 

C ENTRY ^ ) 

(USING FIRST MODEL, DETERMINE (al, ZMPrecpeakal, ZMPrecpeakbl ), WHICH ARE VALUES OF 
(a, ZMPrecpeaka, ZMPrccpeokb) FOR FIRST MODEL CURRENT TIME GAIT TO BE GENERATED TO 
SATISFY BOUNDARY CONDITION, ON THE BASIS OF CURRENT TIME GAIT PARAMETER. 



USING SECOND MODEL, TAKE (al, ZMPrecpeakal, ZMPrecpeakbl ) AS SEARCH INITIAL VALUES 
AND DETERMINE (a2, ZMPrecpeaka2, ZMPrecpeakb2), WHICH ARE VALUES OF 
(a, ZMPrecpeaka, ZMPrecpeakb) FOR SECOND MODEL CURRENT TIME GAIT TO BE GENERATED 
TO SATISFY BOUNDARY CONDITION, ON THE BASIS OF THE ABOVE SEARCH INITIAL VALUES 
AND OTHER CURRENT TIME GAIT PARAMETER. 



USING n-TH MODEL, TAKE (am, ZMPrecpeakam, ZMPrecpeakbm)(WHERE m=n-l ) AS SEARCH 
INITIAL VALUES AND DETERMINE (an, ZMPrecpeakn, ZMPrecpeakbn), WHICH ARE VALUES OF 
(a, ZMPrecpeaka, ZMPrecpeakb) FOR n-TH MODEL CURRENT TIME GAIT TO BE GENERATED TO 
SATISFY BOUNDARY CONDITION, ON THE BASIS OF THE ABOVE SEARCH INITIAL VALUES AND 
OTHER CURRENT TIME GAIT PARAMETER. 
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FIG.22 



S700-1 



c 



ENTRY 



ROVISIONALLY DETERMINE FIRST MODEL ZMP CORRECTION PARAMETER 
CANDIDATE al AND BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED 
VALUE PEAK VALUE CANDIDATES (ZMPrecpeakal, ZMPrecpeakbl ). 



S750 
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S754 



CALCULATE FIRST MODEL CURRENT TIME GAIT UNTIL TERMINATING TIME BY USING FIRST MODEL 
ON THE BASIS OF PARAMETER OBTAINED BY CORRECTING ZMP TRAJECTORY PARAMETER, 
WHICH HAS BEEN PROVISIONALLY DETERMINED BY PROVISIONAL DETERMINING PROCESSING OF 
CURRENT TIME GAIT, BY ZMP CORRECTION PARAMETER CANDIDATE al, BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUE CANDIDATE 
(ZMPrecpeakal, ZMPrecpeakbl ), AND OTHER CURRENT TIME GAIT PARAMETER. 



DETERMINE TERMINAL DIVERGENCE COMPONENT qO[k] 

ACCORDING TO THE FOLLOWING EXPRESSION FROM BODY POSITION/VELOCITY (Xel, Vel ) 
AT TERMINATING END OF CURRENT TIME GAIT: 
q01[k] = Xel+Vxel/wO 



S756 



DETERMINE TERMINAL DIVERGENCE COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EXPRESSION: 
errq = q01[k]-q" 



S758 



TERMINAL BODY INCLINATION ANGLE ERROR 9 berr 

= n-TH MODEL NORMAL GAIT INITIAL BODY INCLINATION ANGLE 

- FIRST MODEL CURRENT TIME GAIT TERMINAL BODY INCLINATION ANGLE 
TERMINAL BODY INCLINATION ANGULAR VELOCITY ERROR cuberr 

= n-TH MODEL NORMAL GAIT INITIAL BODY INCLINATION ANGULAR VELOCITY 

- FIRST MODEL CURRENT TIME GAIT TERMINAL BODY INCLINATION ANGULAR VELOCITY 



S760 



S762 yes 



ARE ALL errq, 9 berr, AND a> berr 
WITHIN PERMISSIBLE RANGES? 



( LEAVE REPETITION LOO?.) 



S764 



DETERMINE A PLURALITY OF INITIAL VALUE CANDIDATES (al + A a, ZMPrecpeakal , ZMPrecpeakbl ), 

(al, ZMPrecpeakal + AZMPrecpeaka, ZMPrecpeakbl ), AND 

(al, ZMPrecpeakal, ZMPrecpeakbl + A ZMPrecpeakb) IN THE VICINITY OF 

(al, ZMPrecpeakal, ZMPrecpeakbl), AND BASED ON THEM, DETERMINE ERROR CORRESPONDING 

TO EACH OF THEM AS DESCRIBED ABOVE. 



DETERMINE NEW PARAMETER CANDIDATES (al, ZMPrecpeakal, ZMPrecpeakbl ) ON THE BASIS OF 
(al, ZMPrecpeakal, ZMPrecpeakbl ) AND ERROR CORRESPONDING TO EACH OF INITIAL VALUE 
CANDIDATES IN THE VICINITY THEREOF. 
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S700-n (n>2) 



FIG.23 
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ENTRY 



S1700 



SUBSTITUTE om AND (ZMPrecpeakom, ZMPrecpeakbm)(WHERE m=n-l ) INTO n-TH MODEL ZMP 
CORRECTION PARAMETER CANDIDATE an AND BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PEAK VALUE CANDIDATE (ZMPrecpeakon, ZMPrecpeakbn), RESPECTIVELY. 



S1704 



DETERMINE TERMINAL DIVERGENCE COMPONENT qO[k] 
ROM BODY HORIZONTAL POSITIONAELOCITY (Xen, Ven) 

AT TERMINATING END OF CURRENT TIME GAIT ACCORDING TO THE FOLLOWING EXPRESSION: 
qOn[k] = Xen + Vxen / cuO 



SI 702 



C 



CALCULATE n-TH MODEL CURRENT TIME GAIT UNTIL TERMINATING TIME BY USING n-TH MODEL 
ON THE BASIS OF PARAMETER OBTAINED BY CORRECTING ZMP PARAMETER, WHICH HAS BEEN 
PROVISIONALLY DETERMINED BY PROVISIONAL DETERMINING PROCESSING OF CURRENT TIME 
GAIT, BY ZMP CORRECTION PARAMETER CANDIDATE an, BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PEAK VALUE CANDIDATE (ZMPrecpeakon, ZMPrecpeakbn), AND OTHER 
CURRENT TIME GAIT PARAMETER. 



SI 706 



DETERMINE TERMINAL DIVERGENCE COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EXPRESSION: 
errq = qOn[k] - q" 



S1708 



TERMINAL BODY INCLINATION ANGLE ERROR 9 berr 

= n-TH MODEL NORMAL GAIT INITIAL BODY INCLINATION ANGLE 

- n-TH MODEL CURRENT TIME GAIT TERMINAL BODY INCLINATION ANGLE 
TERMINAL BODY INCLINATION ANGULAR VELOCITY ERROR a>berr 

= n-TH MODEL NORMAL GAIT INITIAL BODY INCLINATION ANGULAR VELOCITY 

- n-TH MODEL CURRENT TIME GAIT TERMINAL BODY INCLINATION ANGULAR VELOCITY 



S1710 



S1712 yes 



ARE ALL errq, 6 berr, AND coberr 
WITHIN PERMISSIBLE RANGES? 



LEAVE REPETITION LOOP.) 



S1714 



DETERMINE A PLURALITY OF INITIAL VALUE CANDIDATES (an+ A a, ZMPrecpeakon, ZMPrecpeakbn), 

(an, ZMPrecpeakon + A ZMPrecpeaka, ZMPrecpeakbn), AND 

(on, ZMPrecpeakon, ZMPrecpeakbn + A ZMPrecpeakb) IN THE VICINITY OF 

(an, ZMPrecpeakon, ZMPrecpeakbn), AND BASED ON THEM, DETERMINE ERROR CORRESPONDING 

TO EACH OF THEM AS DESCRIBED ABOVE. 



DETERMINE NEW PARAMETER CANDIDATES (an, ZMPrecpeakon, ZMPrecpeakbn) ON THE BASIS OF 
(an, ZMPrecpeakon, ZMPrecpeakbn) AND ERROR CORRESPONDING TO EACH OF INITIAL VALUE 
CANDIDATES IN THE VICINITY THEREOF. 
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FIG.12 



START 



INITIALIZATION (t=0, ETC.) 



S010 



S012 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL CYCLE). 



SOI 4 



S016 



yes 



IS GAIT 
CHANGING? 



t = o 



S018 



READ NEXT TIME GAIT SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLE. 



S020 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETER OF NORMAL GAIT 



S022 



SUBROUTINE FOR DETERMINING INITIAL STATE 

(INITIAL DIVERGENCE COMPONENT, ETCJOF NORMAL GAIT 



S024 



S026 



PROVISIONALLY DETERMINE GAIT PARAMETER OF CURRENT TIME GAIT 
INCLUDING DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETER 
(CORRECT CURRENT TIME GAIT PARAMETER SUCH THAT DIVERGENCE 
COMPONENT AT END OF CURRENT TIME GAIT AGREES WITH INITIAL 
DIVERGENCE COMPONENT OF NORMAL TURNING Wfttft) 6rA(T 



S028 



DETERMINE PARAMETERS OF ZMP PERMISSIBLE RANGE AND FLOOR 
REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE 
FOR FULL-MODEL CORRECTION. 



S030 



SUBROUTINE FOR DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE 



S032 



DETERMINE ARM SWINGING OPERATION TO CANCEL SPIN FORCE 



S034 



S036 



DETERMINE INSTANTANEOUS VALUES OF ZMP PERMISSIBLE RANGE AND FLOOR REACTION 
FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORRECTION. 



GENERATE CORRECTED GAIT USING FULL MODEL. 
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t = t +At 



S040 



END 
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S024 



FIG.14 



ENTRY 
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S200-1 



DETERMINE FIRST MODEL NORMAL TURNING GAIT THAT SATISFIES BOUNDARY CONDITION ON THE BASIS OF 
NORMAL TURNING GAIT PARAMETER BY USING FIRST MODEL AND DETERMINE FIRST MODEL INITIAL (AT Ts) 
BODY HORIZONTAL POSITION, VELOCITY, ANGULAR VELOCITY, AND BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PEAK VALUES (Xsl, Vxsl, M, ZMPrecpeekl ). 



S200-2 



USING SECOND MODEL, TAKE (Xsl, Vxsl, M, ZMPrecpeekl ) AS SEARCH INITIAL VALUES, AND SEARCH FOR 
SECOND MODEL NORMAL TURNING GAIT THAT SATISFIES BOUNDARY CONDITION ON THE BASIS OF THE SEARCH 
INITIAL VALUES AND OTHER NORMAL TURNING GAIT PARAMETER, AND DETERMINE SECOND MODEL INITIAL 
(AT Ts) BODY HORIZONTAL POSITION, VELOCITY, ANGULAR VELOCITY, AND BODY INCLINATION RESTORING 
MOMENT ZMP-CONVERTED VALUE PEAK VALUES (Xs2, Vxs2, o;bs2, ZMPrecpe^2). 



7a- 



S200-n 



USING n-TH MODEL, TAKE (Xsm, Vxsm, cubsm, ZMPrecpee.km)(WHERE m=n-l ) AS SEARCH INITIAL VALUES, 
AND SEARCH FOR n-TH MODEL NORMAL TURNING GAIT THAT SATISFIES BOUNDARY CONDITION ON THE BASIS 
OF THE SEARCH INITIAL VALUES AND OTHER NORMAL TURNING GAIT PARAMETER, AND DETERMINE n-TH 
MODEL INITIAL (AT Ts) BODY HORIZONTAL POSITION, VELOCITY, ANGULAR VELOCITY, AND BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUES (Xsn, Vxsn, wbsn, ZMPrecpetjkn). 



S204 



BASED ON n-TH MODEL NORMAL TURNING GAIT, DETERMINE n-TH MODEL INITIAL BODY POSITION, VELOCITY, 
POSTURE ANGLE, ANGULAR VELOCITIES (XOn, VxOn, e bOn, wbOn), AND INITIAL BODY VERTICAL 
POSITION/VELOCITY (ZOn,VzOn) AT ORIGINAL INITIAL TIME 0. 



DETERMINE n-TH MODEL NORMAL TURNING INITIAL DIVERGENCE COMPONENT q[0] 
BY USING THE FOLLOWING EXPRESSION: 
q[0] = XOn + VxOn/wO 



S222 



S224 



DETERMINE q", WHICH DENOTES VALUE OF n-TH MODEL NORMAL TURNING INITIAL DIVERGENCE 
COMPONENT q[0] OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM OF CURRENT TIME'S GAIT, 
AND DETERMINE (ZO",VzO"), WHICH DENOTE VALUES OF n-TH MODEL INITIAL BODY VERTICAL 
POSITION/VELOCITY OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM OF CURRENT TIME'S GAIT. 
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FIG.15 
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S200-1 



ENTRY 



S250 



DETERMINE INITIAL STATES (STATES AT INITIAL TIME Ts) OF FOOT POSITION/POSTURE, 
BODY POSTURE ANGLE e bs, AND ARM POSTURE ON THE BASIS OF NORMAL TURNING GAIT PARAMETER 



PROVISIONALLY DETERMINE FIRST MODEL INITIAL (ATTs) BODY HORIZONTAL POSITION, VELOCITY, 
ANGULAR VELOCITY, AND BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PEAK 
VALUE CANDIDATES (Xsl, Vxsl, wbsl, ZMPrecpe&l ). 



S252 



S254 



DETERMINE FIRST MODEL INITIAL BODY VERTICAL POSITIONAELOCITY (Zsl , Vzsl ). 



S256 



USING FIRST DYNAMIC MODEL, GENERATE FIRST MODEL GAIT ON THE BASIS OF NORMAL 
TURNING GAIT PARAMETER INCLUDING ZMPrecpeekl, TAKING ebsl, (Xsl, Vxsl, wbsl), 
(Zsl ,Vzsl ) AS INITIAL STATES OF BODY. 



S258 



S260 



CONVERT BODY HORIZONTAL POSITION, VELOCITY, POSTURE ANGLE, AND ANGULAR VELOCITY AT 
TERMINATING END OF GENERATED GAIT INTO VALUES OBSERVED FROM SUPPORTING LEG COORDINATE 
SYSTEM OF NEXT STEP, AND DENOTE THE CONVERTED VALUES AS(Xel,Vxel, ebel, cobel). 



BOUNDARY CONDITION ERRORS (errx, errv, err e , errw ) 
= (Xsl, Vxsl, ebsl, cubsl )-(Xel,Vxel, ebel, cubel) 



S262 



_err6_ 



S264 yes 



ARE ALL errx, errv,w#b, AND 
r " V WITHIN PERMISSIBLE RANGES? 



I 



( LEAVE REPETITION LOOP. ) 



a 



DETERMINE A PLURALITY OF CANDIDATES (Xsl + A Xs, Vxsl , wbsl, ZMPrecpeiakl ), 
(Xsl, Vxsl+AVxs, wbsl, ZMPrecpe&l), (Xsl Vxsl, wbsl+Acobs, ZMPrecpeekl), 
(Xsl , Vxsl , oj bsl , ZMPrecpe&l + a ZMPrecpe4k) IN THE VICINITY OF 
(Xsl, Vxsl, wbsl, ZMPrecpeekl), AND BASED ON THEM, DETERMINE BOUNDARY CONDITION 
ERROR CORRESPONDING TO EACH OF THEM AS DESCRIBED ABOVE. 



S266 



DETERMINE NEW CANDIDATES (Xsl, Vxsl, wbsl, ZMPrecpeekl) ON THE BASIS OF BOUNDARY 
CONDITION ERRORS CORRESPONDING TO (Xsl, Vxsl, wbsl, ZMPrecpeekl) AND EACH OF 
CANDIDATES IN THE VICINITY THEREOF. 
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FIG J 6 



S202-n(n£;2) 



ENTRY 



_) 



DETERMINE INITIAL STATES (STATES AT INITIAL TIME Ts) OE FOOT POSITION/POSTURE, 

BODY POSTURE ANGLE e bs, AND ARM POSTURE ON THE BASIS OF NORMAL TURNING GAIT PARAMETER. 



SUBSTITUTE (Xsm, Vxsm, wbsm, ZMPrecpeekmMWHERE m=n-l) INTO n-TH MODEL INITIAL (ATTs) BODY 
HORIZONTAL POSITION, VELOCITY, ANGULAR VELOCITY, AND BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PEAK VALUE CANDIDATES (Xsn, Vxsn, gjbsn, ZMPrecpeckn). 



SI 200 



S1202 



S1204 



DETERMINE n-TH MODEL INITIAL BODY VERTICAL POSITION/VELOCITY (Zsn, Vzsn). 



S1206 



USING n-TH DYNAMIC MODEL, GENERATE n-TH MODEL GAIT ON THE BASIS OF NORMAL 
TURNING GAIT PARAMETER INCLUDING ZMPrecpeekn, TAKING e bsn,(Xsn, Vxsn, wbsn), 
(Zsn,Vzsn) AS INITIAL STATES OF BODY. 



1208 



S1210 



CONVERT BODY HORIZONTAL POSITION, VELOCITY, POSTURE ANGLE, AND ANGULAR VELOCITY AT 
TERMINATING END OF GENERATED GAIT INTO VALUES OBSERVED FROM SUPPORTING LEG COORDINATE 
SYSTEM OF NEXT STEP, AND DENOTE THE CONVERTED VALUES AS (Xen, Vxen, e ben, ajben). 



BOUNDARY CONDITION ERRORS (errx, errv, err e , erraj ) 
= (Xsn, Vxsn, 6 bsn, a>bsn)-(Xen, Vxen, e ben, when) 



S1212 



er0 



S1214 yes 



ARE ALL errx, errv, tt&k; AND m^kr/en 
WITHIN PERMISSIBLE RANGES? 



~z C LEAVE REPETITION LOOP. 3 



DETERMINE A PLURALITY OF CANDIDATES (Xsn+ aXs, Vxsn, a; bsn, ZMPrecpeekn), 
(Xsn, Vxsn+ aVxs, wbsn, ZMPrecpeekn), (Xsn Vxsn, ajbsn+ a <obs, ZMPrecpeekn), 
(Xsn, Vxsn, ajbs^ZMPrecpeWcn+AZMPrecpeWINTHEVICINITYOF 
(Xsn, Vxsn, a,bsn, ZMPrecpeekn), AND BASED ON THEM, DETERMINE BOUNDARY CONDITION 
ERROR CORRESPONDING EACH OF THEM AS DESCRIBED ABOVE. 



S1216 



-a. 



DETERMINE NEW CANDIDATES (Xsn, Vxsn, wbsn, ZMPrecpeekn) ON THE BASIS OF BOUNDARY 
CONDITION ERRORS CORRESPONDING TO (Xsn, Vxsn, wbsn, ZMPrecpeekn) AND EACH OF 
CANDIDATES IN THE VICINITY THEREOF. * 
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c 
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FIG.20 



S026 



ENTRY 



DETERMINE FOOT TRAJECTORY PARAMETER 
OF CURRENT TIME GAIT. 



S600 



DETERMINE REFERENCE BODY POSTURE TRAJECTORY 
PARAMETER OF CURRENT TIME GAIT. 



S602 



DETERMINE ARM POSTURE TRAJECTORY PARAMETER 
OF CURRENT TIME GAIT. 



S604 



DETERMINE FLOOR REACTION FORCE VERTICAL COMPONENT 
TRAJECTORY PARAMETER OF CURRENT TIME GAIT. 



DETERMINE FLOOR REACTION FORCE HORIZONTAL 
COMPONENT tfflHT RANGE [Fxmin, Fxmax] 
OF CURRENT TIME GAIT. 



S606 



S608 



^ ptErRM/SS'/BLE 



PROVISIONALLY DETERMINE ZMP TRAJECTORY PARAMETER 
OF CURRENT TIME GAIT. 



SET BODY INCLINATION ANGLE RESTORING PERIOD [Ta, Tb] 



S610 



S612 
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FIG.21 



S028 

( ENTRY ") 



USING FIRST MODEL, DETERMINE (al, ZMPrecpefekal, ZMPrecpefekbl ), WHICH ARE VALUES OF 
(a, ZMPrecpe&a, ZMPrecpe&b) FOR FIRST MODEL CURRENT TIME GAIT TO BE GENERATED TO 
SATISFY BOUNDARY CONDITION, ON THE BASIS OF CURRENT TIME GAIT PARAMETER. 



USING SECOND MODEL, TAKE (al, ZMPrecpel^kal, ZMPrecpefckbl ) AS SEARCH INITIAL VALUES 
AND DETERMINE (a2, ZMPrecpe&a2, ZMPrecpe*b2), WHICH ARE VALUES OF 
(a, ZMPrecpeoka, ZMPrecpe&b) FOR SECOND MODEL CURRENT TIME GAIT TO BE GENERATED 
TO SATISFY BOUNDARY CONDITION, ON THE BASIS OF THE ABOVE SEARCH INITIAL VALUES 
AND OTHER CURRENT TIME GAIT PARAMETER. 



USING n-TH MODEL, TAKE (am, ZMPrecpe&am, ZMPrecpefekbm)(WHERE m=n-l) AS SEARCH 
INITIAL VALUES AND DETERMINE (an, ZMPrecpe&n, ZMPrecpeekbn), WHICH ARE VALUES OF 
(a, ZMPrecp^ka, ZMPrecpe&b) FOR n-TH MODEL CURRENT TIME GAIT TO BE GENERATED TO 
SATISFY BOUNDARY CONDITION, ON THE BASIS OF THE ABOVE SEARCH INITIAL VALUES AND 
OTHER CURRENT TIME GAIT PARAMETER. 
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FIG.22 



c 



ENTRY 



c 



S750 



PROVISIONALLY DETERMINE FIRST MODEL ZMP CORRECTION PARAMETER 

CANDIDATE al AND BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED 

VALUE PE AK VALUE CANDIDATES (ZMPrecpeekal, ZMPrecpeekbl). 
rx — — ~ 



S754 



S752 



CALCULATE FIRST MODEL CURRENT TIME GAIT UNTIL TERMINATING TIME BY USING FIRST MODEL 
ON THE BASIS OF PARAMETER OBTAINED BY CORRECTING ZMP TRAJECTORY PARAMETER, 
WHICH HAS BEEN PROVISIONALLY DETERMINED BY PROVISIONAL DETERMINING PROCESSING OF 
CURRENT TIME GAIT, BY ZMP CORRECTION PARAMETER CANDIDATE al, BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUE CANDIDATE 
(ZMPrecpeekal, ZMPrecpeekbl ), AND OTHER CURRENT TIME GAIT PARAMETER. 



DETERMINE TERMINAL DIVERGENCE COMPONENT qO[k] 

ACCORDING TO THE FOLLOWING EXPRESSION FROM BODY POSITIONAELOCITY (Xel , Vel ) 
AT TERMINATING END OF CURRENT TIME GAIT: 
q01[k] = Xel + Vxel/ajO 



S756 



DETERMINE TERMINAL DIVERGENCE COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EXPRESSION: 
errq = q01[k]-q" 



S758 



TERMINAL BODY INCLINATION ANGLE ERROR 6 berr 

= n-TH MODEL NORMAL GAIT INITIAL BODY INCLINATION ANGLE 

- FIRST MODEL CURRENT TIME GAIT TERMINAL BODY INCLINATION ANGLE 
TERMINAL BODY INCLINATION ANGULAR VELOCITY ERROR a; berr 

= n-TH MODEL NORMAL GAIT INITIAL BODY INCLINATION ANGULAR VELOCITY 

- FIRST MODEL CURRENT TIME GAIT TERMINAL BODY INCLINATION ANGULAR VELOCITY 



S760 



S762 yes 



ARE ALL errq, 6 berr, AND cu berr 
WITHIN PERMISSIBLE RANGES? 



Cleave repetition loop.) 



JL. 



S764 
ft 



DETERMINE A PLURALITY OF INITIALVALUE CANDIDATES (al + A a, ZMPrecpeekal, ZMPrecpeekbl ), 

(al, ZMPrecpeekal + A ZMPrecpeSka, ZMPrecpeekbl), AND 

(al, ZMPrecpeekal, ZMPrecpeekbl + AZMPrecpeeJcb) IN THE VICINITY OF 

(al, ZMPrecpeekal, ZMPrecpeekbl), AND BASED ON THEM, DETERMINE ERROR CORRESPONDING 

TO EACH OF THEM AS DESCRIBED ABOVE. 



DETERMINE NEW PARAMETER CANDIDATES (al, ZMPrecpeekal, ZMPrecpeekbl) ON THE BASIS OF 
(al, ZMPrecpeekal, ZMPrecpeekbl ) AND ERROR CORRESPONDING TO EACH OF INITIAL VALUE 
CANDIDATES IN THE VICINITY THEREOF. 
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S700-n(n^2) 



FIG.23 



c 



ENTRY 



c 



S1700 



SUBSTITUTE am AND (ZMPrecpeekam, ZMPrecpeekbm)(WHERE m=n-l ) INTO n-TH MODEL ZMP 
CORRECTION PARAMETER CANDIDATE an AND BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PEAK VALUE CANDIDATE (ZMPrecpeekan, ZMPrecpetekbn), RESPECTIVELY. 



S1702 



S1704 



CALCULATE n-TH MODEL CURRENT TIME GAIT UNTIL TERMINATING TIME BY USING n-TH MODEL 
ON THE BASIS OF PARAMETER OBTAINED BY CORRECTING ZMP PARAMETER, WHICH HAS BEEN 
PROVISIONALLY DETERMINED BY PROVISIONAL DETERMINING PROCESSING OF CURRENT TIME 
GAIT, BY ZMP CORRECTION PARAMETER CANDIDATE an, BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PEAK VALUE CANDIDATE (ZMPrecpeekan, ZMPrecpeekbn), AND OTHER 
CURRENT TIME GAIT PARAMETER. a & 



DETERMINE TERMINAL DIVERGENCE COMPONENT qO[k] 
FROM BODY HORIZONTAL P0SIT10NAEL0CITY (Xen, Ven) 

AT TERMINATING END OF CURRENT TIME GAIT ACCORDING TO THE FOLLOWING EXPRESSION: 
qOn[k] = Xen + Vxen / aid 



SI 706 



DETERMINE TERMINAL DIVERGENCE COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EXPRESSION: 
errq = qOn[k] - q" 



S1708 



TERMINAL BODY INCLINATION ANGLE ERROR 6 berr ^ T&M/W <~ 
= n-TH MODEL NORMAL GAIT INITIAL BODY INCilNATlON ANGLE 

- n-TH MODEL CURRENT TIME GAITtttfflAfBODY INCLINATION ANGLE 
TERMINAL BODY INCLINATION ANGULAR VELOCITY ERROR wberr 

= n-TH MODEL NORMAL GAIT INITIAL BODY INCLINATION ANGULAR VELOCITY 

- n-TH MODEL CURRENT TIME GAIHNfflAL BODY INCLINATION ANGULAR VELOCITY 



S1712 yes 



S1710 



ARE ALL errq, 6 berr, AND cu berr 
WITHIN PERMISSIBLE RANGES? 



Q LEAVE REPETITION LOOP.) 



a 



S1714 



DETERMINE A PLURALITY OF INITIAL VALUE CANDIDATES (an+ A a, ZMPrecpeekan, ZMPrecpeekbn), 

(an, ZMPrecpetikan + AZMPrecpeska, ZMPrecpeekbn), AND 

(an, ZMPrecpeikan, ZMPrecpeekbn + AZMPrecpe&b) IN THE VICINITY OF 

(an, ZMPrecpeekan, ZMPrecpeekbn), AND BASED ON THEM, DETERMINE ERROR CORRESPONDING 

TO EACH OF THEM AS DESCRIBED ABOVE. 



-a. 



-A— 



DETERMINE NEW PARAMETER CANDIDATES (an, ZMPrecpeekan, ZMPrecpeekbn) ON THE BASIS OF 
(an, ZMPrecpeekan, ZMPrecpeekbn) AND ERROR CORRESPONDING TO EACH OF INITIAL VALUE 
CANDIDATES IN THE VICINITY THEREOF. 
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